
Figure 1 - PRIOR ART 



200 



Ramp Loa^/UolOad Imkmt^mm, •■ • - / \^ Actuator Arm 




110 Actuator 



Hasds parked on r?imp ¥^li©n Irti, stops 

Figure 2 - PRIOR ART 




Figure 3 
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Turn VCm off 
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Read in the ADC value through both Vvcm and 
VRsense paths as: ADC{Vref1 ) and ADC(Vref2) 
respectively 



Apply a mall current towards the crash 
stop (Unload direction) 
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Select Vvcm input to the MUX and read In the 
ADC value as: ADC(Vvcm) - ADC(Vref1) 
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Select VRsense input to the MUX and read in 
the ADC value as: ADC(VRsense) - ADC(Vref2) 



Calculate Kcal value such that: 
[ADC(Vvcm)-ADC(Vref1)] - Kcal.[ADC{VRsense)-ADC(Vref2)] = 0 
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Figure 4 
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Set Load Target Velocity as: 
V_Load_Target 



Set Unload Target Velocity as: 
V_Unload_Target 



Receive Vvcm & VRsense 
measurement 



Receive Vvcm & VRsense 
measurement 



Calculate back EMF, Vbemf as: 
Vbemf = (Vvcm - Vref 1 ) - Kcal.(VRsense - Vref2) 



Calculate back EMF, Vbemf as: 
Vbemf = (Vvcm - Vref1) - Kcal.(VRsense - Vref2) 



Calculate the velocity en-or as 
V_Load_Target - Vbemf 



Calculate the velocity error as; 
V_Unload_Target - Vbemf 



Do the loop compensation to obtain 
the desired control response and 
output control copmmand to VCM 




Do the loop compensation to obtain 
the desired control response and 
output control copmmand to VCM 



Wait for the next 
sample time 



Figure 5 




600 



Start 



Determine the value of the Voltage Err for 

this time period, 

Verr(n) 



Calculate the value for the discrete control 
variable, Control(n) as: 

Control(n) = Control(n-l) + (Ki*T - Kp) * Verr 
+ Kp * Verr(n) 
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Send the discrete control variable, 
Control(n), to the driver circuit, which 
compensates the velocity of the header 
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Set the variables Control(n-l) and Verr(n-l) 
as: 

Control(n-l) = Control(n) 
Verr(n- 1) = Verr(n) 
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Figure 6 



